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Abstract 

The equations of motion of a multibody system are nonlinear in nature, and thus pose a 
difficult problem in linear control design. One approach is to have a first-order 
approximation through the numerical perturbations at a given configuration, and to design a 
control law based on the linearized model. In this paper, a linearized model is generated 
analytically by following the footsteps of the recursive derivation of the equations of motion. 

The equations of motion are first written in a Newton-Euler form, which is systematic 
and easy to construct; then, they are transformed into a relative coordinate representation, 
which is more efficient in computation. A new computational method for linearization is 
obtained by applying a series of first-order analytical approximations to the recursive 
kinematic relationships. The method has proved to be computationally more efficient because 
of its recursive nature. It has also turned out to be more accurate because of the fact that 
analytical perturbation circumvents numerical differentiation and other associated numerical 
operations that may accumulate computational error, thus requiring only analytical 
operations of matrices and vectors. 

The power of the proposed linearization algorithm is demonstrated, in comparison to a 
numerical perturbation method, with a two-link manipulator and a seven degrees of freedom 
robotic manipulator. Its application to control design is also demonstrated. 

1. Introduction 

The behavior of a nonlinear dynamic system can be approximated by a linearized model 
in the neighborhood of a reference configuration. Intuitively, linear models of dynamic 
systems can be obtained by simply omitting nonlinear effects of the nonlinear dynamic 
systems, such as Coriolis forces, centrifugal forces, and the interaction forces between bodies. 
Such a model, however, cannot satisfy the needs of computer-aided design of control systems 
for multibody systems because the intuitive simplification is usually case-dependent. 
Therefore, a better linearized dynamic model based on a general purpose dynamics model is 
necessary. The approach that fits this requirement most is first-order approximations of the 
nonlinear dynamic models, which yield valid results in the neighborhood of the reference 
configuration for dynamic and control analysis. A straightforward approach to obtain first- 
order approximations of multibody systems is first to generate the analytical closed-form, 
nonlinear equations of motion of the systems, and then to generate the linearized equations of 
motion using first-order Taylor expansions. Unfortunately, these analytical equations of 
motion are generally not available because they are too complex to be generated. 

Due to the difficulty of analytically generating the closed-form, nonlinear equations of 
motion of a multibody system, a numerical perturbation method is usually applied to obtain a 
linearized model at a certain configuration. For instance, in DISCOS [1] the numerical 
perturbation method is employed to generate a linearized model for stability analysis of a 
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multibody system at a selected configuration. Following a similar idea, Liang [2] implemented 
a numerical perturbation method with DADS [3] for multibody mechanical system control. 
Moreover, the numerical perturbation method has been widely implemented in dynamic and 
control analysis. For example, Sohoni and Whitesell [4] applied it in ADAMS, and Singh, 

Likins, and Vendervoortt applied [5] it to generate linear models of flexible body systems. 

In the implementation of the numerical perturbation method, iterative computations 
are employed to ensure that the resulting linearized models are accurate. However, the 
iterative computation sometimes may not generate a satisfactory linearized model because of 
failure in convergence. Therefore, a trade-off between the accuracy and convergence must be 
made to generate a useful linearized model. An accurate linearized model is difficult to be 
generated with good computational efficiency when the numerical perturbation approaches are 
applied. In resolving this problem, the numerical perturbation method must be avoided during 
the linearization procedure. 

On the other hand, symbolic programming languages can be used to devise efficient 
computational techniques to obtain the linearized manipulator models. Vukobratovic and Nenad 
[6] proposed the linearization technique that first generates the nonlinear dynamic models of 
the manipulator by means of symbolic programming languages, and then takes first-order 
approximation from the given nonlinear model. Following the same approach, Neuman and 
Murray [7] linearized symbolically the Lagrangian dynamic robot model about a nominal 
trajectory to generate the linearized and trajectory sensitivity models of a manipulator. 
Balafoutis, Misra, and Patel [8] further extended Neuman's approach to obtain more 
computational efficiency in generating linearized models by using the fact that the derivatives 
of trigonometric functions need not be computed explicitly, and that the partial derivatives of 
the homogeneous transformation matrices may be obtained merely by row and column 
manipulations. The same idea was applied to generate linearized models for flexible multibody 
systems by Jonker [9]. Thus, although this approach has the advantage of not using the 
numerical perturbation method, there is at the same time a disadvantage: it relies heavily on 
symbolic programming languages. Consequently, the approach is restricted to special case 
studies only until a general purpose symbolic manipulation package for the dynamic modelling 
becomes available. 

In searching for a general purpose computer-aided dynamic analysis algorithm, Bae 
and Haug [10,11,12] developed a recursive formulation, which was later improved by Bae, 
Hwang and Haug [13,14], In this approach, the equations of motion are first written in a 
Newton-Euler form, which is systematic and easy to construct. They are then transformed 
into a relative coordinate representation, which is efficient for computation. This approach is 
extended in this paper to efficiently generate a linearized model using the recursive 
computational structure and applying the analytical linear approximations of the recursive 
kinematic relationships, without applying numerical perturbations. The computational 
efficiency and opportunity for parallelism of the recursive algorithm would make it possible 
to linearize successively for adaptive dynamics control. 

An analytical linearization algorithm is derived by using the recursive variational 
derivation, and by linearizing kinematic relationships analytically. In the recursive 
formulation, the equations of motion are obtained through a series of coordinate 
transformations. By analytically taking first-order approximations of kinematic 
relationships between Cartesian, state vector, and joint variables and then applying these 
linearized relationships in the recursive variational derivation, linearized equations of motion 
are generated in joint space. The proposed linearization algorithm is shown in Fig. 1 and is 
explained as follows: 

( 1 ) Variational equations of motion are obtained in Cartesian space and the generalized mass 
and force are approximated with first-order Taylor expansions. 

( 2 ) First-order approximate kinematic relationships are obtained between Cartesian 
variables and state vector variables [14] and are substituted into the variational 
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equations obtained in (1). Linearized variational equations in state vector space are 
generated. 

(3) First-order Taylor expansions for the kinematical relationships between state vector 
variables and joint variables are obtained, and then substituted into the approximate 
variational equations obtained in (2). 

( 4 ) Linearized equations of motion are obtained from the approximate variational equations 
in joint space. At this stage, open-chain mechanisms are expressed in terms of 
independent coordinates and closed-chain mechanisms are expressed in a mixed 
differential algebraic equation (DAE) form. 

( 5 ) Linearized equations of motion expressed only in terms of independent coordinates are 
written in state space form for control applications. 

The rest of the paper is organized as following. In Section 2, linearized kinematic 
relationships are expressed in terms of the generalized state vector, which is used to simplify 
expressions and to obtain compact equations. In Section 3, linearized relative kinematics 
relations are derived for two contiguous bodies. The linearized equations of motion are 
developed in Section 4. In Section 5, numerical examples of the recursive linearization 
method are given. In addition, control designs based on the linearized models and linear control 
theory are demonstrated. Finally, conclusions are presented in Section 6. 


2. Generalized State Vector Notation 

In this section, a first-order Taylor expansion is applied to approximate the 
relationship between Cartesian variables and generalized velocity state variables. The 
generalized velocity state vector, called the velocity state, is used to simplify expressions in 
later derivations. It is defined as [13] 


r P = 


r p + r p ©p 

C0 n 


(i ) 


where the subscript P represents the origin of a body-fixed frame, as shown in Fig. 2. The 
Cartesian velocity of point P can be written as 


Y P = 


co. 


P J 


( 2 ) 


where r p and cop are the translational velocity of point P and the angular velocity of a body- 
fixed frame at point P, respectively. 

From the velocity expressions in Eqs. 1 and 2, the Cartesian velocity Y p is expressed as 



= Tp Yp ( 3 ) 

Replacing r p by the virtual displacement 8rp and oop by the virtual rotation 8np, yield 
the variation of the position state vector. 

SZp = T P 8Z P ( 4 ) 

The Cartesian acceleration of the body-fixed frame shown in Fig. 2 is defined as the time 
derivative of Eq. 3, 

Y P = T P Y P - V P ( 5 ) 
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where V r 


1 p®p 


is a velocity coupling vector. 


L o J 

Since the right sides of Eqs. 1 to 5 are explicitly expressed in terms of Cartesian 
variables, their first-order expansions can be obtained analytically with respect to 
perturbations in the Cartesian variables. 

First, by expanding Tp at a reference configuration, Eq. 4 can be represented as 

8Z P = ( Tp + d Tp + 0(A) 2 ) 5Z P ( 6 ) 

where d denotes a first-order perturbation with respect to Cartesian variables; the 


superscript o signifi 


dTp = 


3T P 

dZp 


es that the quantity is evaluated at a reference configuration, i.e., 
A 


| evaluated at o 

and A denotes perturbed quantity, which is expressed in terms of the variables in the 
Cartesian space. The perturbation of matrix T p can be obtained as 

0 - dfr, 


dTp = 

' 0 0 

where the partial derivative of the position vector of point P can be expressed as 


(7) 


dr p = dr p 


f p d«p 


( 8 ) 


Similarly, the acceleration relationship, Eq. 5, can be expanded as 

Y P = [ Tp + d Tp + 0(A) 2 ] Y P - [ V p + d Vp + 0(A) 2 ] 

The derivatives of the position state variable and the Cartesian variable can be related 
from Eq. 6 as 


(9) 


dZp = Tp dZp 

and the derivative of the Cartesian velocity vector can be written as 
dY P = d ( T P Y P ) 

= T P d Y P + dTp Y P 


where 


dTp Y P 


(Dp 

0 


-<Dp r p 


dZp 


( 10 ) 


( 11 ) 


( 12 ) 


4* A 

where d Y p and d Z p are the perturbations of velocity and position state vectors. Based on the 

relationships in Eqs. 9, 1 0, and 11, the derivative of the variables in the Cartesian space can 
be expressed in terms of the derivatives of the state variables. 


3. Relative Kinematics of Two Contiguous Bodies 

In this section, a first-order Taylor approximation is derived to represent relative 
kinematic relationships between contiguous bodies that are constrained by a kinematic joint, 
as shown in Fig. 3. The relative kinematic relation between the velocities of the two 
contiguous bodies i and j is defined as [13] 

Yj - Yj + By q,j < 13 > 

where 
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dd h 

Bjj = 3^ + (r i * S ' i)Hi i 

h n 

Relationships between virtual displacements and rotations of these bodies are obtained by 
replacing the velocity vectors in Eq. 13 with virtual translational and rotational vectors; i.e., 

5Z j = 5Z i + B ij 5q ij 4 * * * * * * * * * (14) 

Taking the time derivative of Eq. 13 yields the acceleration relationship 

Yj= Y i+ By q ij+ Djj (15) 

where 


Djj = Bjj q jj 

As shown in Eqs. 13, 14, and 15, the state variables of body j are expressed in terms 
of the state variable of body i and the joint variables used to define the relative motion between 
bodies i and j. The first-order Taylor expansions of Eqs. 14 and 15 with respect to the state 
variable of body i and the joint variables can be expressed as 

5Zj = 8Zj + [ Bfj + dBfj + 0(A) 2 ] 8qjj ( 1 6 ) 

Yj = Yj + [ Bfj + dB?j + 0(A) 2 * ] q ij+ [ D?j + dD?j + O(A) 2 ] (17) 

where dBjj and dDjj are computed in terms of the state variables of body i and the joint 
variables. 

Linearized equations of motion are generated based on the linearized joint kinematic 
relationships and linearized relationships between the state space variables of bodies i and j. 
From Eqs. 13 and 14, relations between the perturbations of state variables and relative 
coordinates are expressed as 


dZj = dZj + Bjj dqjj (18) 

dYj = dYj + dBy qy + Bjj dqjj (19) 


dY, = dYj + dBy qy + By dq 


’lj ' J M|] 


dDi 


( 20 ) 


4. Linearized Equations of Motion of a Tree Structural Mechanism 

The linearized equations of motion of a tree structure mechanism that contains n joints 

and n+1 bodies, as shown in Fig. 4, are presented in this section. By going through the 

procedure of variational derivation (13) and by replacing the nonlinear kinematic 

relationships with their first-order approximations, one can generate the linearized 

equations of motion for an open-chain system. Applying the linearized kinematic 

relationships to the recursive variational approach yields the linearized equations of motion 

that are written in terms of the joint variables. 

4.1 Variational Equations in Cartesian Space 

The variational form of the Newton-Euler equations of motion for an n-body system is 

written as [3] 

n 

0 = ^5Z T j (MjYj-Qj ) (2 1) 

i = 0 
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where Mj is the mass matrix and Qj is the generalized force. The variational equation must 
hold for all kinematically admissible variations 8Zj, i = 1,...,n; i.e., the kinematic constraints 
on the system must be satisfied by 5Zj. Then approximate variational equations can be 
generated from a set of approximations of the generalized mass and force for each body, which 
are expressed as 

Mj = M° + dM? + 0(A) 2 (2 2) 

Qj = Q? + dQ? + 0(A) 2 (23) 

where dMj and dQj are expressed in terms of Cartesian variables. 

4.2 Variational Equations in State Vector Space 

Approximated variational equations in state vector space can be obtained by 
substituting Eqs. 6, 10, 22, and 26 into the equations of motion in Cartesian space and by 
replacing Cartesian variables with the state variables. The approximated variational 
equations can be written as 
n 

0 = X 8 Zi {[TfM^Yj -T J ° ( M^Vf + Q?] + [( dT^M^T? + TjdM < |T < j > + 
i = 0 


T[M^dT?Yj -(dT^ M°vf +T|dM°vf +t| M^V^ +dTjQ° +T{dQft] + 0(A) 2 } 


(24) 

where Vj is a velocity coupling term, which is defined in Eq. 5. In order to simplify Eq. 24, 


the notation of the generalized mass matrix Mj and force vector Qj in the state vector space 

[13] will be used henceforth. The equations of motion are thus expressed as 
n 

0 = X 8 Zj {( M?Yj - Cf) + d M°Yj - dOff + 0(A) 2 } (25) 

i = o 


where 


dMj = dT j M jT j +TjdMjTj +TlMjdTj 


dQj = dTjMjVj +TjdMjVj +T‘[M i dV i +dfjQj +T{dQj 
and dMj, dTj, dVj and dQj, which are expressed in terms of the perturbations of the Cartesian 
variables, can be rewritten in terms of the perturbations of the state variables by 
substituting the relationship between the Cartesian variables and the state variables into 
their expressions. 

4.3. Linearized Equations of Motion in Joint Space 

The approximated variational equations of motion in state vector space can be rewritten 
in terms of joint variables. As the results in Section 3 indicate, the variables in state vector 
space can be transformed into joint variables. The linearized equations in joint space can be 
obtained by applying the following procedures. Substituting the approximated kinematic 
relationship between bodies n and n-1 into the variational equations yields 
n-1 

0 = X 8 Z| {( M?Yj - 6ft + dM°Yj - d6fp + 0(A) 2 } + 

i = 0 


SZn- 1 {( MnY n 


oft 


dM° n Y n 


d6£ + 0(A) 2 } + 


(26) 
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6qJ { (Bj° + dB^ + 0(A) 2 ) [ ( M^Y n - 6£) + dM^Y n - d6£ + 0(A) 2 ]} 

where the perturbations are taken with respect to the state variables of the inboard bodies 
and the relative variables that are used to defined the relative motion between the bodies n and 
n-1. Moreover, the relative kinematic matrix B n _i n is denoted as B n to simplify the 
expressions during the derivation. 

Because joint n is not subject to any relative constraint between the connected bodies, 
the virtual displacement of the joint coordinate is arbitrary. Thus the coefficient of 8q{, is 
equal to zero; i.e., 

0 = (B p 0 + dBp 0 + 0(A) 2 ) [ ( MpY n - 6£) + dM^Yp - dCtf + 0(A) 2 ] (27) 

Substituting the first-order Taylor expansion of the acceleration vector into state vector 
space, and substituting the relationships between state and joint spaces into Eq. 27, gives the 
equation of motion corresponding to joint n. 


0 = Bp ( M°Yp - 6£) + d (Bp M°Y°) -d(Bp c£ ) + 0(A) 2 ) 


(28) 


where 


d (BpM n Yp) = dBpM n Yp + B^dM n Y n + B^M n dY n 


T-iii 


>T»i 


d(BpQ n ) = dBpQp + BpdQp 


»T jA 


and dM n anddQ n can be written in terms of the state variables of body n-1 and the relative 
variables that are used to define the relative motion between bodies n and n-1. Moreover, the 
equation of motion corresponding to joint n at the reference configuration is 


0 = Bj°( m°y° - off) (29) 

Substituting the relationship in Eq. 29 into Eq. 28 and omitting higher order terms yields 

0 = d (B n°MpYp) -dfBjoft ) (30) 


where Y n can be expressed in terms of the derivative of a set of independent variables 


x ( = [ yJ Y$ 2 j 0 q{ q{ q{ ... qj qj q^] T ) by substituting the relationships from Eqs. 

18, 19, and 20 recursively for j from n to 1. 

Following the same arguments used in obtaining Eq. 30, one can obtain the linearized 
equations of motion corresponding to joint i as 

0 = BT|° d( KjYj + K i+1 B i+1 q i+ i + ... + K n B n q n - Lj)° + 


dB]° ( KjYj + K i+ i B i+ i q i+ i+ ... + K n B n q n - Lj)° 

for i = 1 n < 31 > 

where Kj = Mj + Kj + ^, Lj = Qj + Lj + i - Kj + -|Dj + -|, K n = M n , and L n = Q n . 

By repeating the above procedure in backward path sequence to the base body, one can 
obtain the linearized equation of motion for the base body as 

d(K 0 Y 0 + K 1 B 1 q 1+ ... + K n B n qp-L 0 ) 0 =0 (32) 
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For the open-chain mechanism, the linearized equations of motion at the reference 
configuration, which are represented in Eqs. 31 and 32, can be obtained recursively. During 
the derivation, every perturbed term in the linearized equations can be computed either from 
the perturbed variables in the Cartesian variables, which are computed analytically, or from 
the analytically linearized relationships among the Cartesian, state vector, and joint 
coordinate spaces. 


5. Numerical Examples 

In this section, the applications of the recursive linearization algorithm are illustrated 
by two examples: a two-link manipulator and a robot arm with seven degrees of freedom. The 
accuracy and computational efficiency of the proposed algorithm are demonstrated by 
comparing the models obtained from the recursive algorithm with those obtained from the 
analytical approach and from a numerical perturbation method. In the case of the two-link 
system, an exact linearization is accomplished by the use of the symbolic manipulator 
(MACSYMA) [15]. However, to generate the exact linearized model for a complicated system 
is very difficult, even with a symbolic manipulator. In the second example, a numerical 
perturbation is applied to the robot with seven degrees of freedom in order to generate a 
reference linearized model with which the results of the recursive linearization algorithm are 
compared. 

5J A Two-Link Manipulator 

In this subsection, a two-link manipulator, as shown in Fig. 7, is modeled and tested. 
Since all the joints are revolute, one independent coordinate is assigned to each joint. The 
manipulator can be modeled as a system of two differential equations. For this system, the 
linearization can also be carried out analytically by using the symbolic manipulator 
(MACSYMA). Therefore, it is possible to check the accuracy of the recursive linearization 
algorithm by comparing the linear models obtained from both approaches: recursive 
linearization and MACSYMA implementation. 

The recursive linearization produced a linearized model at the specified configuration 


that was defined by setting e-j, e 2> 6^ and 0 2 to zero. The linearized equation of motion is 
written as 


d&2 
de 1 
d§2 
-dG! _ 


0 

0 

-5.191 
1 .1537 


0 1 

0 0 

3.4612 0 

-4.0380 0 


rde 2 - 


de 1 


d6g 

+ 

J Lde-i _ 



0 

0 

-0.0824 

0.0294 


0 1 

0 rdT 2 l 

0.0294 LdTj 
-0.01 76-1 


(33) 

where Ti and T 2 are actuating torques that are applied at the revolute joints. At the same 
specified configuration, the symbolic manipulation generated the exact linearized model, which 
is identical to the one obtained from the recursive linearization approach. A comparison of the 
numerical and analytical results shows that the proposed recursive linearization algorithm 
can generate a correct linearized model at a given configuration. 

After the linearized model is obtained, a linear controller can be designed by applying 
the linear model to existing control design tools. A linear regulator is designed to control the 
motion of the manipulator by using the Pro-Matlab package. The pole placement algorithm 
[16] is used to compute the full state feedback gain matrix for the nonlinear dynamic model. 
The effectiveness of this regulator is tested by applying an initial deviation of the system and 
using the regulator to stabilize it. As expected, the linearized model can well represent the 
nonlinear model. Therefore, a small initial deviation is tested first. The results of 0.05 
radian initial deviations are shown in Figs. 6 and 7. The nonlinear system can be stabilized by 
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the linear regulator. Similar results are presented in Figs. 8 and 9 for 1.0 radian initial 
deviations. 

However, the pole placement algorithm for a multiple-input multiple-output system 
does not have a unique solution [ 17 ]. The feedback gain obtained from the Pro-Matlab package 
is an iterating solution, which is designed to find an insensitive set for the configuration 
change. However, this algorithm requires a lot of computation to generate an optimal gain 
matrix. Thus, this algorithm cannot be used for an on-line computation for the real time 
simulation. To fulfill the on-line computation requirement, a simple and stable pole 
placement algorithm is needed. A case particularly interesting is to determine the feedback 
controller [ 1 7 ] in such a way that the closed loop equation is decomposed into a set of n 
decoupled second-order differential equations. 

0 = d0j + 2^j G)j d0j + co? d0j ; i = 1 , .... n (34) 

where the damping factor and the undamped frequency ©j of each tracking error are 
specified by the designer. Defining the nxn constant diagonal matrices A^= diagj{2^j C0j } and 
A 2 = diagj{ to? }, one can obtain the desired decoupled closed loop equation from Eq. 34 as 

0 = d 0 + A-|d 0 + A 2 d 0 (35) 

The closed loop equation of the linearized model with a proportional-derivative (PD) 
controller can be written in a second order differential equation form as 

0 = M d 0 + ( P r K v )d 0 + ( P 2 - K P ) d 0 ( 36 ) 

where Kp is the position feedback gain matrix and Ky is the velocity feedback gain matrix. 
Equating coefficients in Eqs. 35 and 36 gives the desired closed-loop feedback gain matrices as 

K v = MAt - Pt ( 37 ) 

Kp = MA 2 - P 2 (3 8) 

Consequently, a linear regulator is designed to control the dynamic system. As shown in Figs. 
10, 11, 12, and 13 , the linear regulator can stabilize the nonlinear dynamic model for both 
small and large initial deviation cases. 

5.2 A Robot with Sev en Degrees of Freedom 

Figure 10 shows a robot arm that has seven degrees of freedom. The system consists of 
eight bodies, including the base body, which is designated as ground. The adjacent bodies are 
connected by revolute joints. Joints 1 to 7 are identified as Shoulder Roll, Shoulder Pitch, 
Elbow Roll, Elbow Pitch, Wrist Roll, Wrist Pitch, and Toolplate Roll. 

Since adjacent bodies are connected by revolute joints, one generalized coordinate is 
assigned to each joint. The motion of this system can be described by seven generalized 
coordinates; the dynamic system is thus formulated as a system of seven differential equations. 
When a reference configuration is selected, a linearized model can be generated at this 
configuration using the proposed linearization algorithm. 

The configuration that is shown in Fig. 10 is selected as a reference configuration: the 
angles of all the joints are zero (q^ , q 2 = 0), and the velocities of all the joints are also 

zero ( 0 -| , ..., 07 = o). At this reference configuration, the linearized model that is obtained 
from the recursive linearization algorithm is expressed as 


dx = 


M' 1 P 2 


M’ 1 P 


r 0 i 

dx + M -i D du 
1 J LM P 3 J 


( 39 ) 


where x = [q, q 2 q 3 q 4 q 5 q6 07 ^2 % ^4 % % • u is the actuating torque 

vector, M is the generalized mass matrix that is expressed in terms of joint variables, and 
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M ’P, - 0 7 „7 


15.737 

0 -1.607 

0 

-.1451 

0 -.18e-8 

0 

15.228 0 

2.8549 

0 

-.3485 0 

.41697 

0 9.2375 

0 

-.4480 

0 -.13e-7 

0 

-11.44 0 

-6.361 

0 

.5637 0 

-29.11 

0 3.711 

0 

21.533 

0 ,93e-7 

0 

-5.0345 0 

-13.19 

0 

-15.76 0 

.14.914 

0 5.9428 

0 

-25.38 

0 -.58e-7_ 


P 3 .l 

In this case, to generate a closed-form analytical expression for the linearized model is 
too difficult for accuracy checking even if the symbolic manipulation is employed. Instead, two 
comparisons were derived to make certain that the linearized model in Eq. 39 accurately 
represents the nonlinear model. In the first comparison, both the nonlinear and linearized 
models were perturbed with the same amount, and then the resulted acceleration changes were 
examined. In the second comparison, two linearized models-one obtained from the recursive 
approach and the other obtained from the numerical perturbation method-are examined. 

In the first comparison, perturbation of the generalized coordinate x by 
1 0' 6 incurs the relative error of the acceleration changes between the linearized and 
nonlinear model as 


II dx* -dx || 2 
II dx*|| 2 


= 2.739 e-6 


(40) 


where dx is the acceleration change obtained from the linearized model and dx is obtained 
from the nonlinear model. 

In the second comparison, a simple numerical perturbation without any convergence 
checking is implemented to generate a linearized model, which will serve as a reference in 
comparing the recursive linearization with the numerical perturbation. Comparing the 
linearized model obtained from the numerical method with those obtained from the recursive 
approach, one can observe that at the given configuration both approaches generate nearly 

identical linearized models, in which the relative difference is less than 10' 6 . 

However, the recursive algorithm proves to be more efficient than the numerical 
perturbation method. In comparison with the numerical perturbation method, the recursive 
linearization took half the cpu time to generate a linear model, even though the numerical 
perturbation method used here was a relatively simple one. If a convergence checking 
algorithm was employed for the numerical perturbation method, it would take even longer to 
generate a linear model. 

The simple pole placement used in the previous example was used again to design a 
linear regulator. The desired closed-loop poles were selected to make the simulation results 
similar to the experimental results. After properly selecting the desired poles, we used this 
linear regulator to control the nonlinear dynamic model. The step response of Joint 4 is shown 
in Fig. 1 1 . From this result, it is clear that a simple regulator based on a linearized model 
simulates the behavior of a complicate control system around a reference configuration. 


6. Conclusion 

In these examples, we have shown that the proposed linearization algorithm is both 
efficient and accurate in generating a linear model at given configurations. These linear 
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models are converted to the standard state space forms, which are convenient for linear 
control design. Moreover, the driving force input for a required motion around a given 
configuration can be predicted by using the linearized model. When a large gross motion is 
involved in a prescribed trajectory, more than one linearized model may be necessary for 
robust control. In such a case, the computation of linearization must be fast enough to update 
the linearized model before it fails to represent the system adequately. With the emerging 
parallel processing computers and computation algorithm, the use of successive linearization 
will be possible for on-line adaptive control. 

References 

1 . Bodley, C., Devers, A., Park, A., and Frisch, H., A digital Computer Program for Dynamic 
Iteration an d Simulation of Controls and Structures (D1SCOL NASA Tech. Paper 1219, 
May 1978. 

2. Liang, C.G., and Lance, G.M., Dynamic Analysis and Control Synthesis of Integrated 
Mechanical Systems . Ph.D. Thesis, University of Iowa, 1985. 

3 . Haug, E.J., Computer Aided Kinematics and Dynamics of Mechanical Systems. Volume I: 
Basic Method . Allyn & Bacon, Boston, 1989. 

4. Sohoni, V.N., and Whitesell, J., "Automatic Linearization of Constrained Dynamical 
Models," Journal of Mechanism. Transmission, and Automation in Design. Transactions of 
the ASME . vol. 108, Sept., 1986, p. 300-304. 

5. Singh, R.P., Likins, P.W., and VenderVoortt, R.J., "Automated Dynamics and Control 
Analysis of Constrained Multibody System," Robotic & Manufacturing Automation . 1985, 
p. 109-113. 

6. Vukobratovic, M. and Nenad, K., "Computer-oriented Method for Linearization of Dynamic 
Models of Active Spatial Mechanisms," Mechanism and Machine Theory . Vol. 17, No. 1, 
1982, p.21-32. 

7. Neuman, C., "Linearization and Sensitivity Functions of Dynamic Robot Models," IEEE 
Transactio ns on Systems. Man, and Cybernetics , vol. 14, no. 6, 1984, p.805-818. 

8. Balafoutis, C.A., Misra, P., and Patel, R.V., "Recursive Evaluation of Linearized Dynamic 
Robot Models," IEEE J. of Robotics and Automation . Vol. RA-2, No. 3, 1986, p. 146-155. 

9. Jonker. J.B., A Computer-Oriented Method for Linearization of The Dynamic Mechanism 
Equations . Lab. Report no. 822, Department of Mechanical Engineering, Delft University 
of Technology, The Netherlands, 1986. 

1 0. Bad, D.S. and Haug, E.J., "A recursive Formulation for Constrained Mechanical Systems, 
Part I- Open Loop," Mechanics of Structures and Machines . Vol. 15, No. 4, 1987. 

1 1 . Bad, D.S. and Haug, E.J., "A recursive Formulation for Constrained Mechanical Systems, 
Part II- Closed Loop," Mechanics of Structures and Machines . Vol. 15, No. 4, 1987. 

12. Bad, D.S., Haug, E.J., and Kuhl, J.G., "A recursive Formulation for Constrained Mechanical 
Systems, Part III- Parallel Processor Implementation," Mechanics of Structures and 
Machines . Vol. 16, No. 2, 1988. 

13. Bae, D.S., Hwang, R.S., and Haug, E.J., "A Recursive Formulation for Real-Time Dynamic 
Simulation," Submitted to Journal of Mechanisms. Transmissions, and Automation in 
Design . 

14. Hwang, R.S., Bae, D.S., Kuhl, J.G., and Haug, E.J., "Parallel Processing for Real-Time 
Dynamic Simulation," Submitted to Journal of Mechanisms. Transmissions, and 
Automation in Design . 

15. VAX UNIX Macsvma Reference Manual. Version 11, Symbolics, Inc. 1985. 

16. Kautsky, J., Nichols, N.K., and Van Dooren, P., "Robust Pole Assignment in Linear 
State Feedback," International Journal of Control . Vol. 41, No. 5, p. 1129-1155, 

1985. 


67 



17. Brady, Hoilerbach, Johnson, Lozano-P'eroz, and Mason, editor, Robot Motion.; 
Planning and Control. The MIT Press, Cambridge, 1983. 



Figure 1. Recursive Derivation Flow for Dynamic Equations of Motion and 
Proposed Linearization Algorithm 
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Figure 8. Response of small Initial Deviation Figure 9. Response of large Initial Deviation 



70 






